
import Project.Main as Main
import robo3pi as a
import time
import math
import serial
import ControlFunctions as f

    

#Define Params
ID = '3'
edgeLength = 0.21
timePerEdge = 1
Main.ROTATION_TIME_360 = 2.65

Main.LEFT_WHEEL_OFFSET = 0
Main.RIGHT_WHEEL_OFFSET = 0
# this is the com the xbee dongle identified itself on my computer.
a.init('COM' + str(Main.COM_PORT))
#f.rotateByAngle(ID, 360)
time.sleep(2)
#a.move('5', 100, 100)
f.moveInLineAdapter(ID, 90)
#f.moveInLine(ID, 90)
time.sleep(2)
a.stop()
#f.moveInLine (ID, -0.25 , 0.1)
#time.sleep(2);
#f.stop()
#f.rotateByAngle(ID, 90)



#f.rotateByAngle(ID, 90) # Rotate towards point 3
#time.sleep(0.5)


a.close()